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Abstract — This paper presents an analytical model and a 
geometric numerical integrator for a system of rigid bodies 
connected by ball joints, immersed in an ir rotational and 
incompressible fluid. The rigid bodies can translate and rotate 
in three-dimensional space, and each joint has three rotational 
degrees of freedom. This model characterizes the qualitative 
behavior of three-dimensional fish locomotion. A geometric 
numerical integrator, refereed to as a Lie group variational 
integrator, preserves Hamiltonian structures of the presented 
model and its Lie group configuration manifold. These proper- 
ties are illustrated by a numerical simulation for a system of 
three connected rigid bodies. 

I. Introduction 

Fish locomotion has been investigated in the fields 
of biomechanics and engineering (see [1] and references 
therein). This is a challenging problem as it involves inter- 
action of a deformable fish body with an unsteady fluid, 
through which an internal muscular force of the fish is 
translated into an external propulsive force exerted on the 
fluid. 

Various mathematical models of fish locomotion have been 
formulated. A quasi-static model based on a steady state flow 
theory is developed in [2], and an elastic plate model that 
treats a fish as an elongated slender body is studied in [3], 
[4], [5]. The effects of body thickness for the slender body 
model are considered in [6]. Numerical models involving 
computational fluid dynamics techniques appear in [7], [8]. 
The body of a fish is modeled as a planar articulated rigid 
body in [9], [10], [11]. 

The planar articulated rigid body model has become 
popular in engineering area, as it depicts underwater robotic 
vehicles that move and steer by changing their shape [12], 
[13]. Furthermore, if it is assumed that the ambient fluid is 
incompressible and irrotational, then equations of motion of 
the articulated rigid body can be derived without explicitly 
incorporating fluid variables [9]. The effect of the fluid is 
accounted by added inertia terms of the rigid body. This 
model is known to characterize the qualitative behavior 
of fish swimming properly [9]. Based on this assumption, 
optimal shape changes of a planar articulated body to achieve 
a desired locomotion has been studied in [14], [15]. 
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By following [9], [10], [11], we consider a system of 
connected rigid bodies immersed in a incompressible and 
irrotational fluid, and we first develop an analytical model of 
it. The contribution of this paper is that the connected rigid 
bodies can freely translate and rotate in three-dimensional 
space, and each joint has three rotational degrees of freedom. 
This is important for understanding the locomotion of a fish 
with a blunt body and a large caudal fin. 

The second part of this paper deals with a geometric 
numerical integrator of connected rigid bodies in a perfect 
fluid. Geometric numerical integration is concerned with 
developing numerical integrators that preserve geometric 
features of a system, such as invariants, symmetry, and 
reversibility [16]. It is critical for a numerical simulation 
of Hamiltonian systems on a Lie group to preserve both the 
symplectic property of Hamiltonian flows and the Lie group 
structure [17]. A geometric numerical integrator, referred to 
as a Lie group variational integrator, has been developed for 
a Hamiltonian system on an arbitrary Lie group in [18]. 

A system of connected rigid bodies is a Hamiltonian 
system, and its configuration manifold is expressed as a 
product of the special Euclidean group and copies of the 
special orthogonal group. This paper develops a Lie group 
variational integrator for the connected rigid bodies in a per- 
fect fluid based on the results presented in [18]. The proposed 
geometric numerical integrator preserves symplecticity and 
momentum maps, and exhibits desirable energy properties. 
It also respects the Lie group structure of the configuration 
manifold, and avoids the singularities and complexities as- 
sociated with local coordinates. 

In summary, this paper develops an analytical model and 
a geometric numerical integrator for a system of connected 
rigid bodies in a perfect fluid. These provide a three- 
dimensional mathematical model and a reliable numerical 
simulation tool that characterizes the qualitative properties 
of fish locomotion. 

This paper is organized as follows. A system of connected 
rigid bodies immersed in a perfect fluid is described in 
Section [TT] An analytical model and a Lie group variational 
integrator are developed in Section [III] and in Section |IV] 
respectively, followed by a numerical example in Section [V] 

II. Connected Rigid Bodies Immersed in a Perfect 

Fluid 

Consider three connected rigid bodies immersed in a 
perfect fluid. We assume that these rigid bodies are connected 
by a ball joint that has three rotational degrees of freedom, 
and the fluid is incompressible and irrotational. We also 
assume each body has neutral buoyancy: the mass of the 
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Fig. 1. Connected Rigid Bodies Immersed in a Perfect Fluid 

body equals the mass of the fluid it displaces. This model is 
illustrated by Fig. Q] 

We choose a reference frame and three body-fixed frames. 
The origin of each body-fixed frame is located at the mass 
center of the rigid body and it is aligned along the principal 
axes. Define 

Ri G S0(3) Rotation matrix from the i-th body-fixed 

frame to the reference frame 
Hi G M 3 Angular velocity of the i-th body, repre- 
sented in the i-th body-fixed frame 
i£R 3 Vector from the origin of the reference 

frame to the mass center of the 0-th body, 
represented in the reference frame 
Vector from the mass center of the i-th 
body to the ball joint connecting the i-th 
body with the j-th body, represented in the 
i-th body-fixed frame 
Mass of the i-th body 
Inertia matrix of the i-th body 

fori, j G {0,1,2}. 

A configuration of this system can be described by the lo- 
cation of the mass center of the central body, and the attitude 
of each rigid body with respect to the reference frame. So, 
the configuration manifold is G = SE(3) x SO(3) x SO(3), 
where SO(3) = {R G R 3x3 \R T R = J, det.fi = 1}, and 
SE(3) = SO(3)©R 3 . 

The attitude kinematics equation is given by 

Ri = Rifli 

for i G {0,1,2}, where the hat map : : M 3 — > so(3) is 
defined such that xy = x x y for any x,y G M 3 . 

III. Continuous-time Analytical Model 

In this section, we develop continuous-time equations of 
motion for a system of connected rigid bodies in a perfect 
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fluid. As the fluid is irrotational, equations of motion can 
be expressed without explicitly incorporating fluid variables, 
and the effects of the ambient fluid is encountered by added 
inertia terms [9]. To simplify expressions for the added 
inertia terms, we assume each body is an ellipsoid. 

We first find an expression for the Lagrangian of the 
system, and substitute it into Euler-Lagrange equations. 

A. Lagrangian 

The total kinetic energy of connected rigid bodies im- 
mersed in a fluid can be written as the sum of the kinetic 
energy of the rigid bodies and the kinetic energy of the 
fluid 1>: 



r = E T ^ 
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Kinetic energy of rigid bodies: Let V; £ E 3 be the 
velocity of the mass center of the i-th body represented in 
the i-th body-fixed frame for i G {0, 1, 2}. Since x represents 
the velocity of the 0-th rigid body in the reference frame, we 
obtain 



Vn 



Rlx. 



(1) 



The location of the mass center of the first rigid body can be 
written as x + fio^oi — Ridio with respect to the reference 
frame. Therefore, V\ is given by 



Similarly, 



V 2 



Rj(x + Ro&odoi — Ri&idw) 
.fii x — R^ Rodoi^Q — dio^i- 



R%x 



fin i?Q^02^0 + obo^2 



The kinetic energy of rigid bodies is given by 
2 1 1 



(2) 



(3) 



(4) 



Kinetic energy of fluid: The kinetic energy of the fluid 
is given by 



7> 



Pf h\\ dv, 



where pj is the density of the fluid, u is the velocity field of 
the fluid and dv is the standard volume element in M 3 . Since 
the flow is irrotational, the velocity field can be expressed as 
a gradient of a potential. Under these conditions, the kinetic 
energy of the fluid can be written as 

2 1 1 



i,j=0 

where M,£- , j/- . 



G 



3x3 are referred to as added inertia 
matrices [19]. Here we assume that the flow near one rigid 
body is not affected by other rigid bodies: the added inertia 



matrices ML , jf. 



D 



. . . , . . are equal to zero when i ^ j. The 
resulting model captures the qualitative properties of the 



Jo - doiB$ RiMifig Rodoi - chzR^ R 2 M 2 rt R d 02 doi RqRi M x Rf + do 2 R^R 2 M 2 R^ d 01 R% RxMx&xo do 2 R%R 2 M 2 d 20 ~ 
-RiMxRjRodoi- R 2 M 2 R$Rodo2 RoM R% + RxMxRf + R 2 M 2 R% RxMxdxo^ R 2 M 2 d 20 

d 10 M 1 RfR d i -dioMxRj Jx - dxoMxdxo 

d2oM 2 R%Rodo2 -dvoMztfZ J 2 - d 20 M 2 d 2 o . 

(5) 



interaction between rigid body dynamics and fluid dynamics 
correctly [9], [14]. 

Expressions for added inertia matrices for an ellipsoidal 
body are derived in [20]. Let l q £ K be the length of the 
q-th principal axis of an ellipsoid for q £ {1,2,3}. Define 
constants 



dv 



for q £ {1,2,3} and 



Ai 



(^ 2 -^) 2 (73 - 72) 



2 (/2_ Z 2 ) + a 2 + Z 2 )(72 _ 73) 



Constants A2 and A3 are given by cyclic permutations of this 
expression. Then, the added inertia matrices of the ellipsoid 
are given by 



71 



72 



73 



(6) 



M f = m b diag 

[2 -71 2-72 2-73 
Jf =diag[A 1 , A 2 , A 3 ], (7) 
D f = 0. (8) 

Using these expressions, we find added inertia matrices 
, j{ t for each rigid body. 
In summary, the kinetic energy of the fluid surrounding 
ellipsoidal rigid bodies is given by 



2 1 1 



(9) 



Total kinetic energy: Define total inertia matrices 

M i =m b i h x a+ML (10) 



J — r + v 



(11) 



for i = {0, 1, 2}. From (0]l and (|9), the total kinetic energy 
is given by 



2 1 1 



i=0 



Substituting dXJ-([3l>, this can be written as 



(12) 



(13) 



where £ = [f2o; i; f2i ; ^2] £ R 12 and the matrix 
l(R ,R 1 ,R 2 ) £ R 12x12 is given by ©. Since there is 
no potential field, this is equal to the Lagrangian of the 
connected rigid bodies immersed in a perfect fluid. 



B. Euler- Lag range Equations 

Euler-Lagrange equations for a mechanical system that 
evolves on an arbitrary Lie group are given by 

fViL{g, - adj • T> 6 L(g, £) - T*L S • D g L(g, £) = 0, 



9 = g£, 



(14) 
(15) 



where L : TG ~ G x g — > K is the Lagrangian of the 
system [18]. Here T)cL(g, £) € 0* denotes the derivative of 
the Lagrangian with respect to £ £ g, ad* : g x g* — > g* is 
co-ad operator, and T*L g : T*G — » g* denotes the cotangent 
lift of the left translation map L g : G — » G (see [21] for the 
detailed definitions). 

Using this result, we develop Euler-Lagrange equations 
of a system of connected rigid bodies in a perfect fluid. 
To simplify the derivation, we consider the configuration 
manifold given by G = SO(3) x JR 3 x SO(3) x SO(3), left- 
trivialize TG to yield G x g, and identify its Lie algebra g 
with R 12 by the hat map. For £ = [fl ; &\ S7i ; ^2] G an d 
P = [Poi Px) Pi) P2] S g*, the co-ad operator is given by 
ad*-p = [-n p ;p x ; -CliPf, -Cl 2 p2]- 

Derivatives of the Lagrangian: The derivative of the 
Lagrangian with respect £ is given by 

T>^L{g^)=l{R Q ,R x ,R 2 )i. (16) 

The derivative of the Lagrangian with respect to g — 
(Rq,x, Ri, R2) £ G can be written as 

T* e L g - T> g L(g,0 

= [T/L flo • T>r L; D X L; T}L Rl ■ T) Rl L; T}L R2 • T> R2 L]. 

(17) 

An expression for the first term of this can be found as 
follows. For any 770 £ R 3 , let g$ = [i?o exp er] , x, Ri, R2] £ 
G. Then, we have 



(T*-L flo • T> Ro L) • 770 = j- 



L(9 e o,0 



e=0 



x T R Q M f jQ Rlx + ^odoiRoRiMiRfRofjodoiQo 



x T RiM.Rf RofjodoiQo - Q% d ifj R£ RiMid i0 Q., 
1 2 _ \ 



= -Rl xMqRq x 



1 = 1 



d 0i floR Q RiMiVi ■ 770, 



where we use identities: x ■ y = x y — y x, xy = —yx for 
any x,y £ R 3 . Since this is satisfied for any 770 £ R 3 , we 



obtain 

2 

i=l 

(18) 

Similarly, we find 

D x i = 0, (19) 
T}L Rt ■ D Rz L = MiV,Rj{± - R d 0i n a ) (20) 

for i G {1,2}. 

Euler-Lagrange Equations: Substituting (|T6Tt-(l20b into 
([T4]i-(fT5Tl, and rearranging, Euler-Lagrange equations for the 
connected rigid bodies immersed in a perfect fluid are given 

by 



X 

hi 



fi x Jft + Rl±M Rlx + ELi iW* 

fii x JxQi + Vi x MiVi - dioVKi 
fi 2 x J 2 2 + V 2 x M 2 F 2 - d 2 oWi 



0, 



(21) 



i?o — JZfli) i?i ~ i?2 — R2Q2, (22) 



where 



V< = Rfx - RjR d 0t n a + diotti, 



(23) 



Wi = Mi - MA){Rjx - RfR d 0i n ) 

- MiRfRohodoiflo + hiMidiotti (24) 

for i G {1,2}. 

Hamilton 's equations: Let the momentum of the system 
be ,u = \po]p x \Pi\Pi} S M 12 — 0*. The Legendre transfor- 
mation is given by 

At = D € i( 5 ,0=I(^o,H 1)J R2)e- (25) 
The corresponding Hamilton's equations can be written as 



Po = -hoPo - RlxM Rlx - doiQ-oRfiRiMiVi, 



1=1 



Px = 0, 

Pi = -hiPi + M~V,Rf(x - R d 0i n ) 



(26) 
(27) 
(28) 



for i G {1,2}. 

Conserved quantities: As the Lagrangian is invariant 
under rigid translation and rotation of the entire system, 
the total linear momentum p x G K 3 and the total angular 
momentum pn = xp x + X^ = o ^Pi e ^ 3 are preserved. 



IV. Lie Group Variational Integrator 

The continuous-time Euler-Lagrange equations and Hamil- 
ton's equations developed in the previous section provide 
analytical models of the connected rigid bodies in a perfect 
fluid. However, they are not suitable for a numerical study 
since a direct numerical integration of those equations using 
a general purpose numerical integrator, such as an explicit 
Runge Kutta method, may not preserve the geometric prop- 
erties of the system accurately [16]. 

Variational integrators provide a systematic method 
of developing geometric numerical integrators for La- 
grangian/Hamiltonian systems [22]. As it is derived from a 
discrete analogue of Hamilton's principle, it preserves sym- 
plecticity and the momentum map, and it exhibits good total 
energy behavior. Lie group methods conserve the structure 
of a Lie group configuration manifold as it updates a group 
element using the group operation [23]. 

These two methods have been unified to obtain a Lie group 
variational integrator for Lagrangian/Hamiltonian systems 
evolving on a Lie group [18]. This preserves symplecticity 
and group structure of those systems concurrently. It has been 
shown that this property is critical for accurate and efficient 
simulations of rigid body dynamics [17]. 

In this section, we develop a Lie group variational integra- 
tor for the connected rigid bodies in a perfect fluid. We first 
obtain an expression for a discrete Lagrangian and substitute 
it into the discrete-time Euler-Lagrange equations. 

A. Discrete Lagrangian 

Let h > be a fixed integration step size, and let 
a subscript k denote the value of a variable at the fc-th 
time step. We define a discrete-time kinematics equation 
as follows. Define f k = (F 0k , Ax k , F lk , F 2k ) £ G for 
Ax k £ M 3 , F Qk , F lk , F 2k G SO(3) such that g k+1 = g k f k : 

(R 0k+1 ,x k+ i, Ri k+1 , R 2k+1 ) 

= (R 0k F 0k: x k + Ax k , R lk F lk: R 2k F 2k ). (29) 

Therefore, f k represents the relative update between two 
integration steps. This ensures that the structure of the Lie 
group configuration manifold is numerically preserved. 

A discrete Lagrangian Ld(g k , f k ) : G x G — > K is an 
approximation of the Jacobi solution of the Hamilton-Jacobi 
equation, which is given by the integral of the Lagrangian 
along the exact solution of the Euler-Lagrange equations over 
a single time step: 

r-ll 



Ld(gk,fk 



L(g(t),g~\t)g(t))dt, 



where g(t) : [0, h] — > G satisfies Euler-Lagrange equations 
with boundary conditions g(0) = g k , g(h) = g k f k . The 
resulting discrete-time Lagrangian system, referred to as 
a variational integrator, approximates the Euler-Lagrange 
equations to the same order of accuracy as the discrete 
Lagrangian approximates the Jacobi solution. 

The kinetic energy given by (fT3l can be rewritten as 



T 



1 



1 



-x 1 RqMqR'o x + -Qq ^0 



x 1 RiMiRi + -fi- { Ji - di Midio)Cli 



+ 2^0i^o RiMiRj Rodoi + % T RiMiRj Rodoi 
- i T R l M i Cl l d i0 - d^R^RiMiQidio) ■ 
^From this, we choose the discrete Lagrangian as 

Ld k = ^AxlRo k M Q R^ h Ax k + ~tr[(J - F 0k )J do ] 

2 1 1 

+ E (^^kRi.MiRlAxk + -tr[(7 - F ik )J' d% ] 



i=l 
1 



2fl d oi( F o k - ^RokRikMiRikRoAFok -I)doi 



-AxlRi.MiRlRo^Fo.-^d 



0; 



AxlRi.MiiFi, - I)d 



~ ^ d U F l - I)^ h Ri u Mi^iu ~ Wio 
where nonstandard inertia matrices are defined as 



(30) 



(31) 



J'd, = if\J'i\ I ~ Ji J'i = J i- dioMjio, (32) 
for i e {1,2}. 

B. Discrete-time Euler-Lagrange Equations 

For a discrete Lagrangian on G x G, the following discrete- 
time Euler-Lagrange equations, referred to as a Lie group 
variational integrator, were developed in [18]. 



T e L / fe • D / fc Ai fc - Ad *f-i • (T e L /fc+1 ■ T> fk+1 L dk+1 ) 

k+1 (33) 
+ T e L gfc+1 • T) gk+1 L dk+1 = 0, 

9k+i = gkfk, (34) 

where Ad* : G x g* — > g* is co-Ad operator [21]. 

Using this result, we develop a Lie group varia- 
tional integrator for connected rigid bodies in a per- 
fect fluid. For / = (F , Ax, Fi, F 2 ) G G and 
P = \Po;px;PV,P2] G g* ~ Rl2 > the co-Ad oper- 
ator is given by Ad}-ip = [F p ; p x ; Fxpi, F 2 p 2 ] = 
[(F p F^) v ;p x ;{F 1Pl F[) v ;(F 2 p 2 F 2 T ) v }, where the vee 
map V : so (3) — * M 3 denotes the inverse of the hat map. 

Derivatives of the discrete Lagrangian: We find ex- 
pressions for the derivatives of the discrete Lagrangian. The 
derivative of the discrete Lagrangian with respect to Fo k is 
given by 

1 1 2 

B FOk L dk ■ 5F Qk = -u{-5F 0k J da } + -J2Aj k R<> h 6Fo h doi, 

i=l 

where we define, for i G {1,2}, 

A lk = R lk Mi (Rf k B lk - {F lk - I)d M ) , (35) 
B lk = Ax k + R 0k (F 0k ~ I)d 0i . (36) 



The variation of Fo k can be written as SFo k = Fo k (o k for 
Co fc 6 K 3 . Therefore, we have 

T>F ,L dk ■ (F 0k (o k ) = (T/Ljr • T> F L dk ) ■ Co k 



1 

= fc tt 



-Fo k (o k J do 



y^, A f k R Qk+iCo k doi. 



i=l 



By repeatedly applying a property of the trace opera- 
tor, tr[AB] = tx[BA] = tr[A T B T ] for any A, B G 
]R 3x3 , the first term can be written as tr{— F 0k £ 0k J do } = 
tr { _ Co fc ^d -Fo fc } = to{Co k Fo k J do } = ~^ir{C, Qk (J da F 0k - 
FQ k J do )}. Using a property of the hat map, x T y = —^ti[xy] 
for any x, y G R 3 , this can be further written as ((J do Fo k — 
F o k J d ) y ) ■ Co k - As xy = -yx for any x,y G M 3 , 
the second term can be written as Af k Ro k+1 £o k doi = 
- A T k Ro k+ Joi(o k = {d 0l Rl k+i A ik ) ■ ( 0k . Using these, we 
obtain 

T I L Fa k ■ D F 0fc L dk 

= -^(Jd a F 0k - F^ k J da Y + - ^2 doiRl k+1 A lk . (37) 

i=i 2 

Similarly, we can derive the derivatives of the discrete 
Lagrangian as follows. 



-r{J'i d F i k ~ F ? k J LY - T^Fj k MiR T ik B^ 



1 



1 



1 



T> Axk L dk = -Ro.MoR^Axk + -Ai„ + ~A 2 

T I L Ro k ■ D «o fc L d k = 



(38) 



(39) 



Um rI Ax k ) A Rl A ^ + j X)((*b» - I)doi) A Rl k Ai k , 



(40) 
(41) 



Discrete-time Euler-Lagrange Equations: Substituting 
(|37T> — (HTb into (|33l-(l34ll, and rearranging, discrete-time 
Euler-Lagrange equations for the connected rigid bodies 
immersed in a perfect fluid are given by 

(Jo d F 0k - F 0k J 0d ) v - (F 0k+1 J 0d - Jo d FQ k+1 ) v 

+ Ai H1 ) A 4 H Aihi 

2 (42) 

+ J2doiRZ k+1 (Ai h -Ai k+1 ) = 0, 



(j' p -F T T V -(F- J' ~ J' F T ) 



I ciT \\l 

+ i 



d M Ff k M t RlB lk 



+ ( F ik+idioMiRf k+i + Rf k+i A ik+1 )B ik+1 - 0, 
R 0k M Q Rl k Ax k + A lk + A 2k 

- Ro k+1 M Rl +i Ax k +i - A lk+1 - A 2k+1 = 0, 
R o k+1 = Ro k F Qk , 

Ri k +l = Rik F k J 
X k +1 = X k + Ax k , 



(43) 



(44) 

(45) 
(46) 
(47) 



where inertia matrices are given by ( [3Tb , ( [32b , and 
Ai k ,B ik G JR 3 are given by (05), (ED for i S {1,2}. For 
given (go-/o) G G x G, ji £ G is obtained by (l45l>— (1471, 
and /i e G is obtained by solving d42l>— d44b . This yields a 
discrete-time Lagrangian flow map (go, fo) —> (gi, fi), an d 
this process is repeated. 

Discrete-time Hamilton's Equations: Discrete-time 
Legendre transformation is given by 

iik = -T*L 9(C • T> gk L dk + Ad* i • (T*L /fc • T> fk L dk ). 

J k 

Substituting this into discrete-time Euler-Lagrange equations, 
we obtain discrete-time Hamilton's equations for the con- 
nected rigid bodies immersed in a perfect fluid as follows. 

h POk = (F 0k J Qd - Jo d Fl) v ~ (M RlAx k fRlAx k 

2 

+ Y^d^Rl k M k , (48) 

z=l 

hp ik = [F lk J' ld - J' ld FlY - i F^jko Mi Rf k B lk 

-±.Rj k A tk B lk , (49) 

hp Xk = R 0k M Ro k Ax k +A lk + A 2k , (50) 
-Rofc+i = Ro k Fo k , (51) 

R ik + l = R ik F iki ( 52 ) 

Xk+i = x k + Ax k , (53) 

2 

hpo k+1 = (Jo d F 0k ~FlJ 0d ) v +^4< +1 A 4fc , (54) 

i=l 

h Ptk+1 = (J( d F ik - FlJ' ld Y - d i0 FlMiRlB ik , (55) 
Px k+1 =Px k , (56) 

where inertia matrices are given by (fjlj, ( |32l , and 
A lk ,B lk e M 3 are given by <|35}, (ED for i e {1,2}. For 
given (go, Mo) € Gxg*, f 1 6 G is obtained by solving (|48T>— 
(l50l . and gi 6 G is given by d5T1>-(l5"3"ll. The momenta at the 
next step is obtained by (T54l>— (f56l> . This yields a discrete-time 
Hamiltonian flow map (go,/J,o) — * (gi,fj,i), and this process 
is repeated. 

V. Numerical Example 

We show computational properties of the Lie group vari- 
ational integrator developed in the previous section. The 
principal axes of each ellipsoid are given by 

Body 0: h =8, h = 1-5, h = 2 (m), 
Body 1,2: h =5, l 2 = 0.8, l 3 = 1.5 (m). 

We assume the density of fluid is p = lkg/m 3 . The 
corresponding inertia matrices are given by 

M = diag[1.0659, 2.1696, 1.6641], (kg) 
Mi = M 2 = diag[0.2664, 0.6551, 0.3677] (kg), 
J = diag[1.3480, 20.1500, 25.3276] (kgm 2 ), 
Ji = J 2 = diag[0.1961, 1.7889, 2.9210] (kgm 2 ). 



The location of the ball joints with respect to the mass center 
of each body are chosen as 

doi = -d 2 = [8.8, 0, 0], d w = -d 2Q = [5.5, 0, 0] (m). 

The initial conditions are as follows: 

Ro - /, fl 0o = [0.2, 0.1, 0.5] (rad/s), 
R lo = 7, fi lo = [0.1, -0.3, -0.2] (rad/s), 
R 2o = I, n 2o = [-0.1, 0.4, -0.6] (rad/s), 
x = [0, 0, 0] (m), x = [0, -0.4142, -0.5900] (m/s). 

The corresponding total linear momentum is zero. These 
initial conditions provide a nontrivial rotational maneuver of 
the connected rigid bodies (an animation illustrating this ma- 
neuver is available at |http : //my . fit . edu/~taeyoung] ). 

We compute discrete-time Hamiltonian flow according 
to (|48])-(|5oT), and as comparison, we numerically integrate 
the continuous-time Hamilton's equations (f26b — (f28b using 
an explicit, variable step size, Runge-Kutta method. The 
timestep of the Lie group variational integrator is h = 0.001 
and the maneuver time is 100 seconds. 

Fig. |2] shows the resulting angular/linear velocity re- 
sponses, total energy, total linear momentum, total angular 
momentum deviation, and orthogonality errors of rotation 
matrices. The Lie group variational integrator and the Runge- 
Kutta method provide compatible trajectories only for a short 
period of time. 

The computational properties of the Lie group variational 
integrator are as follow. As shown in Fig. |2(b)| the computed 
total energy of the Lie group variational integrator oscillates 
near the initial value, but there is no increasing or decreasing 
drift for long time periods. This is due to the fact that 
the numerical solutions of symplectic numerical integrators 
are exponentially close to the exact solution of a perturbed 
Hamiltonian [24]. The value of the perturbed Hamiltonian is 
preserved in the discrete-time flow. The Lie group variational 
integrator preserves the momentum map exactly as in Fig. 
|2(d)| and |2(f)| and it also preserves the orthogonal structure 
of rotation matrices accurately. The orthogonality errors, 
measured by ||7 - RfRiW for i e {0,1,2}, are less than 
10" 13 in Fig. [2(h)l 

These show that the structure-preserving properties of the 
Lie group variational integrator are important for simulat- 
ing the dynamics of the connected rigid bodies in a fluid 
accurately. A more extensive comparison study of the com- 
putational accuracy and efficiency of Lie group variational 
integrators can be found in [17]. 

VI. Conclusions 

We have developed continuous-time equations of motion 
and a geometric numerical integrator, referred to as a Lie 
group variational integrator, for a system of connected rigid 
bodies immersed in a perfect fluid. The rigid bodies are 
modeled as three-dimensional ellipsoids, and each joint has 
three rotational degrees of freedom. This model characterizes 
qualitative behaviors of three-dimensional fish locomotion. 
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(a) Angular Velocity of Body 0, Qq 



(b) Total Energy 
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(c) Angular Velocity of Body 1, Qi 
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(e) Angular Velocity of Body 2, VI2 
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(d) Total Linear Momentum 
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(f) Deviation of Total Angular Momentum 
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(g) Velocity x (h) Orthogonality Error ||7. - RjRi\\, i £ {0, 1, 2} 

Fig. 2. Numerical simulation of connected rigid bodies in a perfect fluid (LGVI: red, solid, RK(4)5: blue, dotted) 



The continuous-time equations of motion provide an an- 
alytical model that is defined globally on the Lie group 
configuration manifold, and the Lie group variational inte- 
grator preserves the geometric features of the system, thereby 
yielding a reliable numerical simulation tool. 
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